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Beschreibung 

Verfahren zur bahntreuen Abbremsung der 
Achsantriebe von numerisch gesteuerten 
Maschinen 

Die Erfindung bezieht sich auf ein Verfahren 
nach dem Oberbegriff des Hauptanspruchs. Ein sol- 
ches Verfahren ist aus der EP-A-0 102 219 bekannt. 
Im Normalbetriebwird dabei die Bahntreue zwareinge- 
halten, jedoch ergeben sich bei Notbremssituationen 
die im weiteren geschilderten Problem. 

Bei numerisch gesteuerten Maschinen, insbe- 
sondere bei Werkzeugmaschinen oder Robotern, ist 
furGefahrensituationen eine Notbremsung der Achs- 
antriebe vorgesehen, die entweder durch eine NOT- 
AUS-Bedienung anwenderseitig oder durch externe 
Gerate oder in folge einer internen Fehlerreaktion 
ausgelost wird. Bei einer solchen Notauslosung sol- 
len die Ant He be der numerisch gesteuerten Maschine 
in kurzester Zeit durch entsprechende Vorgabe der 
Drehzahlsollwerte linear abgebremst werden. Etwa 
30 bis 50 Millisekunden nach der Notauslosung wird 
dann eine sicherheitstechnisch notwendige Kurz- 
schlu&bremsung eingeleitet, so dak die Motoren un- 
ter Umgehung der Steuerung auf jeden Fall zum Still- 
stand kommen. 

Bei einer solchen Notbremsung kann die nume- 
risch gesteuerte Maschine die vorbestimmte Werk- 
zeugbahn nicht mehr einhalten, da die Achsen unab- 
hangig voneinander gebremst werden. Seibst wenn 
die Achsantriebe so synchronisiert werden, daft eine 
zeitliche Anpassung der Achsen an die Achse mit der 
geringsten Verzogerung erfolgt, kommtes zumindest 
bei gekrummten Bahnen zu Bahnabweichungen. 

Die Schwierigkeiten bei der Wiederauf nahme des 
Bearbeitungsvorganges sind noch das geringste Pro- 
blem bei einer solchen Notbremsung. Weit grd&ere 
Probleme entstehen, wenn das Werkzeug bei der 
Bahnabweichung mit dem Werkstuck oder anderen 
Gegenstanden koll id iert oder wenn sich beispielswei- 
se Kollisionen zwischen mehreren nebeneinander ar- 
beitenden Robotern ergeben. 

Es ist Aufgabe der Erfindung, ein Verfahren der 
eingangs genannten Art zum zeitoptimalen bahntreu- 
en Abbremsen von numerisch gesteuerten Maschi- 
nen zu schaffen. 

Dieses Verfahren wird durch die kennzeichnen- 
den Merkmale des Hauptanspruchs geldst. Es la&t 
sich auf alle Bewegungen anwenden, bei dem die 
Achswinkelwerte unmittelbar vorliegen, wie bei- 
spielsweise bei der Punkt- zu Punktbewegung. In die- 
sem Zusammenhang wird unter der Werkzeugbahn 
auch die Bahn verstanden, die das Werkzeug bei ei- 
ner Punkt- zu Punktbewegung zurucklegt. 

Wenn die Achswinkelstellungen nicht direkt vor- 
liegen, sondern erst uber eine Koordinatentransfor- 
mation aus einem anderen Koordinatensystem, bei- 



spielsweise aus einem kartesischen Koordinatensy- 
stem berechnet werden mussen, so ist dafur eine 
Ausbildung der Erfindung vorgesehen. bei der die 
Interpolations- und Bremsinterpolationspunkte in 

5 dem nichtachsspezifischen Koordinatensystem be- 
rechnet und dann ins achsspezifische Koordinaten- 
system zur Bestimmung der Achsantriebsverzoge- 
rung transformiert werden. 

Zur Erhohung der Sicherheit bei der Notbrem- 

10 sung ist es vorteilhaft auch bei diesem Verfahren 
nach einer vorgegebenen Zeitspanne eine Kurz- 
schlufibremsung einzuleiten. 

Ein Ausfuhrungsbeispiei der Erfindung wird an- 
handderZeichnung imfolgenden naher beschrieben. 

15 Die Figur zeigt das Diagramm der Achswinkel- 

stellung aj der Achse j uber einem von der Zeit t ab- 
hangigen Interpolations parameter s(t). Der Interpol a- 
tionsparameters(t) kann im einfachsten Fall direkt die 
Zeit t sein oder er kann als steuerungsinterne Sy- 

20 stemzeit (tau) mit der Zeit t verknupft sein; auch die 
Weglange ware als Interpolations parameter s(t) 
denkbar. Die Wahl dieses Parameters kann mit Ruck- 
sicht auf die jeweilige Steuerung dem Fachmann 
uberlassen werden. 

25 Vom Interpolator einer numerischen Steuerung 

werden Interpolationspunkte P berechnet, die die 

Achswinkelstellung A = (a 1p a 2 a n ) allern Achsen in 

Abhangigkeit vom Interpolationsparameter s(t) ange- 
ben. Im Interpolationstakt i soil 

30 t = t, (1) 

sft) = s, (2) 

A(s,) = A, = (a^.aj, a ni ) (3) 

gelten. Sj und A f bestimmen den Interpolationspunkt 
Pi. Mit diesen Achswinkelstellungen Ai werden die 

35 Achsantriebe einer numerisch gesteuerten Werk- 
zeug maschine oder eines Roboters geregelt, so da& 
das jeweilige Werkzeug eine vorbestimmte Bahn ab- 
fahrt. 

Wenn zwischen zwei Interpolationspunkten P M , 
40 Pj ein NOT-AUS-Signal vorliegt (in der Figur durch ein 
Blitzsymbol angedeutet), so wird ein Bremsinterpola- 
tionspunkt P iB berechnet, der zwischen dem vorher- 
gehenden Interpolationspunkt P,. , und dem Interpola- 
tionspunkt P| liegt, der erechnet werden wurde, wenn 
45 kein NOT-AUS-Signal vorlSge. Der Bremsinterpolati- 
onspunkt P iB wird so berechnet, daS fur jede Achse 
die maximal mogfiche Bremsbeschleunigung (Verzo- 
gerung) angesetzt wird. Dabei soli der zum Bremsin- 
terpolationspunkt P iB gehorende Bremsinterpolati- 
so onsparameter s [B zwischen S). 1 und s, liegen und mit 
k bestimmt sein: 

S JB = Si . ! + k . (s, - s, . ,) (4) 
Fur kleine InterpolationsintervaEle lassen sich die 
zugehorigen Achswinkelstellungen Aj B hinreichend 
55 genau nach Gleichung 5 bestimmen: 

A, B = A| . , + k . (A, - A, . ,) (5) 
Gleichung 5 IS&t sich bei einer Punkt- zu Punkt- 
bewegung direkt anwenden, da bei dieser Bewegung 
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die Achswinkelstellungen unmitteibar berechnet war- 
den konnen. Falls die Achswinkelstellungen wie bei- 
spielsweise bei einer Continuous-Path-Bewegung 
nicht unmitteibar vorliegen, mussen diese zunachst 
aus den vorliegenden Geometriedaten, beispielswei- 
se aus kartesischen Koordinaten durch eine Koordi- 
natentransformation berechnet werden. Diese Koor- 
dinatentransformationen sind aus dem Stand der 
Technik hinreichend bekannt so daB im folgenden 
darauf nicht welter eingegangen zu werden braucht. 

Da in der Regel bei den numerisch gesteuerten 
Maschinen die maximal zulassige Bremsbeschleuni- 
gung - (da 2 /dt 2 ) max = - S^furjede Achse verschie- 
den ist wird zunachst fur jede Achse aj ein eigener op- 
timaler Faktor kj berechnet 



0) - 2 a, 



(aj (s, . 1) + kj (aj(s,) - a^s, . 
(s,_ i) + aj (s,. ^YT^ (6) 

wobei T (po die Interpolationstaktzeit der numerischen 
Steuerung ist 

Aus den n-Faktoren kj (j = 1...n) wird der grSBte 
Faktor kj ausgewahlt, so da& die Achse j mit ihrem Ma- 
ximalwert und die Gbrigen Achsen weniger stark ge- 
bremst werden, was bedeutet, dad die Achse j die f uh- 
rende Achse ist, die die Verzogerung festlegt. Falls k 
kleiner 0 wird, ist der StiJIstand erreicht und k wird auf 
Null gesetzt. 

Die so ermittelten Achswinkelstellungen A| B mit 
dem dazugehdrigen Parameter s IB ersetzt anschlie- 
fiend fur diesen Interpolationstakt die vorab berech- 
neten Achswinkelstellungen A« und den vorab berech- 
neten Parameter s,: 

A| : - A(a (7) 
s, : = Sia (8) 

In jedem der folgenden Interpolationstakte wird 
die fuhrende Achse neu bestimmt, d.h. das beschrie- 
bene Verfahren muS bei jedem Interpolationstakt 
ausgefuhrt werden, bis der Roboter zum Stillstand 
gekommen ist Oder bis eine Kurschlu&bremsung mit 
grd&erer Prioritat eingeleitet wird. 

Wenn es die Sicherheitsaspekte und -vorschrif- 
ten zulassen, sollte die ZeitverzSgerung mit der die 
Umrichter der numerischen Steuerung auf Kurz- 
schlu fibre msung wechseln, so eingestellt werden, 
dad die Mechanik mit dem beschriebenen Verfahren 
unter alien Umstanden zum Stillstand kommt, bis die 
Kurzschlufibremsung einsetzt Dies ist beispielsweis 
dann der Fall, wenn die Werkzeugmaschine oder der 
Roboter im Automat ikbetrieb eingesetzt ist und eine 
verriegelbare Schutztur, die dann auch verriegelt sein 
mu&, vorhanden ist 
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1.1 Vom Interpolator der numerischen Steue- 
rung werden zur Bewegung der Achsen Inter- 
polationspunkte (P ( ) der Achswinkelstelfung 
(A<) = (an, aa, ... a nJ ) allern Achsen uber einem 
Interpolations parameter (s(t)) bestimmt 
gekennzeichnet durch die weiteren Schritte: 
1.2. bei Auslosung einer Notbremsung zwh 
schen zwei Interpolationspunkten (PuPi) 
wird ein Bremsinterpolationspunkt (P [B ) be- 
rechnet, dessen zugehoriger Parameterwert 
(s IB ) zwischen dem vorhergehenden Interpo- 
tationsparameterwert (s^ A ) und dem Interpo- 
lations parameterwert (s,), derohne Notbrem- 
sung berechnet worden ware, liegt, wobei sich 
der Bremsinterpolationsparameter (s ie ) und 
die zugehorigen Achswinkelstellungen (A iB ) 
erg e ben zu: 

Sib = s,. , + k. (s, - s,. ,) (1) 
A, B = A,. , + k.(A, - A,, t) (2) 
wobei k so bestimmt wird, da&mindestens ein 
Achsantrieb mit ein em maximal zulassigen 
Wert und die verbleibenden Achsantriebe 
schwacher gebremst werden, wobei fur jede 
Achswinkelstellung a } fur jede Achse j sich da- 
mit ein eigener optimaler Faktor kj ergibt, der 
zur maximal zulassigen Bremsbeschleuni- 
gung -a max im folgenden Zusammenhang 
stent 

-a maj( = (ajfsj. 0 + ^(a^si) - aj(s,_ ,)) - 2 
a, (s, . ,) + a, (s, . 2))^ (3) 
wobei T|po die Interpolationstaktzeit der nume- 
rischen Steuerung ist, 

1.3 Schritt 1.2 wird zur Bestimmung jedes 
weiteren Bremsinterpolationspunktes (P lB ) bis 
zum Stillstand der Achsbewegungen durch- 
gefuhrt, wobei jeweils nach Bestimmung von 
Gleichung (1 ) und (2) S| durch s iB und A) durch 
Aj B ersetzt wird. 

2. Verfahren nach Anspruch 1, wobei die 
Interpolations- und Bremsinterpolationspunkte 
(Pi.Pta) in einem nicht-achsspezifischen Koordh 
natensystem berechnet und dann in das achs- 
spezifische Koordinatensystem zur Bestimmung 
der Achsantriebsverzogerung transformiert wer- 
den. 

3. Verfahren nach einem der vorstehenden Anspru- 
che, wobei nach einer vorgegebenen Zeitspanne 
eine KurzschluRbremsung eingeleitet wird. 
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Claims 



1. Verfahren zur bahntreuen Abbremsung der Achs- 
antriebe von numerisch gesteuerten Maschinen 
mit folgendem Schritt 



1 . A method for the true-to-path braking of the axle 
drives of numerically controlled machines com- 
prising the following step: 
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1 . 1 for the movement of the axJes, the interpo- 
lator of the numerical control system defines 
interpolation points (Pi) of the axle angular 

position (AJ = (a„, a^ a*) of ail n axles over 

an interpolation parameter (s(t)) f 
characterised by the further steps: 

1.2 on the tripping of an emergency braking 
between two interpolation points (P M , P,), a 
braking interpolation point (P, B ) is calculated, 
the associated parameter value (S| B ) of which 
lies between the preceding interpolation para- 
meter value (s,_ 0 and the interpolation para- 
meter value (sj which would have been calcu- 
lated without emergency braking, where the 
braking interpolation parameters (s, B ) and the 
associated axle angular positions (Ai B ) are 
calculated as follows: 

S, B = S,_ i + k-(S, - S,. 0 (1) 

Aib = A, . , + k . (A, - A, . ,) (2) 
where k is defined such that at least one axle 
drive is braked with a maximum permissible 
value and the remaining axle drives are not 
braked so heavily, where for each axle angu- 
lar position aj for each axle j a separate opti- 
mal factor kj thus occurs, which factor kj exhib- 
its the following relationship with the maxi- 
mum permissible braking acceleration - a,^: 
-*n« = (aj(s,_ ,) + k,(aj(s,) - a,(s,. A )) - 2 
Ms. - 0 + Ms,. 2))/T 2 , P o (3) 
whereT lpo is the interpolation dock cycle time 
of the numerical control system, 
1 .3 step 1 .2 is carried out in order to determine 
each further braking interpolation point (P iB ) 
until the axle movements come to a standstill, 
where in each case in accordance with Equa- 
tion (1) and (2) s, is replaced by s, Q and A, is 
replaced by A< B . 



sition angulaire (A,) = (a,,, a^, ... a nl ) de tous 
les n axes par I'interpolateur de la commande 
numerique, par I'intermediaire d'un parametre 
(s(t)) d'interpolation, 
5 caracterise par les etapes supplementaires 

suivantes : 

1.2. du dedenchementd'un freinage d'urgen- 
ce entre deux points (P,_ u P ( ) d'interpolation, 
on calcule un point (P iB ) d'interpolation de f rei- 

10 nage, dont la valeur associee (s tB ) du parame- 

tre est comprise entre la valeur (S(_ prece- 
dente du parametre d'interpolation et la valeur 
(Sj) du parametre d'interpolation, que Ton au- 
rait calcule sans freinage d'urgence, le para- 

15 metre (s IB ) d'interpolation de freinage et les 

positions (A 1B ) angulaires associees des axes 
etant donnes par : 

s, a = s,_ ! + k.(s, - s,_ 0 (1) 
Ab = A,. + k.(A| - A|. t ) (2) 

20 et k est determine de sorte que I'on freine au 

moins un dispositif d'entrafnement d'un axe a 
une valeur admissible maximum et que Ton 
freine les dispositifs d'entrafnement d'axes 
restants plus faiblement, avec obtention d'un 

25 facteur (kj) optimum qui est propre a chaque 

position aj angulaire de chaque axe j et qui est 
en relation avec I'acceleration de freinage - 
a max admissible au maximum de la maniere 
suivante : 

30 - a^ = (aj (s, . 1) + kj (aj(s,) - aj (s, . ,)) - 2 

M s i-i) + M s i- 2))^T2 ipo (3) 
T [po etant le temps de cadence d'interpolation 
de la commande numerique, 
1.3 on effectue I'etape 1.2 pour determiner 
35 chaque autre point (P )B ) d'interpolation de 

freinage jusqu'a I'arret des mouvements des 
axes, S| etant remplace par s (B et A| par A( B 
comme determine respectivement par les 
equations (1) et (2). 



2. A method as daimed in Claim 1, where the inter- 
polation- and braking interpolation points (P,, P lB ) 40 
are calculated in a non-axle-specific coordinate 
system and are then transformed into the axle- 
specific coordinate system for the determination 

of the axle drive deceleration. 

45 

3. A method as daimed in one of the preceding 
claims, where a short-circuit braking is intro- 
duced after a predetermined interval of time. 



Revendicatlons 

1. Precede de freinage, tout en conservant fidele- 
ment la trajectoire, des dispositifs d'entrafne- 
ment d'axes de machines a commande numeri- 55 
que, comportant I'etape suivante : 

1.1 on determine, pour le mouvement des 
axes, des points (P|) d'interpolation de la po- 



2. Proc6de suivant la revendication 1, dans lequel 
on calcule les points (P,, P iB ) d'interpolation et 
d'interpolation de freinage dans un systeme de 
coordonnees non specifique des axes et on les 
transform e dans le systeme de coordonnees 
specif iques des axes, pour determiner la decele- 
ration du dispositif d'entrafnement d'axe. 

3. Procede suivant Tune des revendications prece- 
dentes, dans lequel on dedenche un freinage a 
court-circuit apres un laps de temps present. 
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